#ifndef MOTION_CONTROL_HPP
#define MOTION_CONTROL_HPP

#include <ESP32Servo.h>

typedef struct Joint_s
{
    int left[2];
    int right[2];
} Joint;

void initServo();
void setServoDegree(int degree_1, int degree_2, int degree_3, int degree_4);

void moveForward();
void moveBackward();
void turnLeft();
void turnRight();
void stop();


#endif // MOTION_CONTROL_HPP